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Device to determine the road followed by a person on 
foot ■ 

The present invention concerns a device to determine the 
5 road followed by a person on foot, more particularly to 
determine the covered distance and/or the followed route. 

Such devices are already known under the term "Global 
Navigation System", for example devices, of the type 
"Gallileo", GPS and the like. 

10 Devices are also known which are based on the 
mensurations of accelerometers provided on the body of 
the person concerned and which are coupled to relatively 
complex peripheral equipment with scanners, cameras and the 
like . 

15 A disadvantage of such known devices is that they 
are relatively complex -and expensive and that they 
have only a limited accuracy and reliability. 

Another disadvantage is that they usually require a 
very time-consuming calibration procedure and that they 
20 are relatively sensitive to varying magnetic fields, 
such that they cannot be used just anywhere and for 
any application whatsoever. 

Another disadvantage is that such devices also 
require a major arithmetic capacity, the 
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consequence being that the results .are usually 
only available with a certain delay, which implies 
that such devices are not suitable for real time 
evaluations , 

5 Another disadvantage is that, with such devices, it is not 
always possible to determine the direction of the 
movements of the person on foot concerned. 

Another disadvantage is that such devices often cannot be 
used in an autonomous and portable manner. 

m 

10 The present invention aims to remedy one or several of the 
above-mentioned and other disadvantages. 

To this end, the invention concerns a device to 
determine the road followed by a person on foot, which 
mainly consists of at least three inertia sensors 

15 attached to the body of the person, one sensor to the 
torso and one sensor to each leg respectively, and which 
measure the absolute orientation of the part of the 
body concerned to which they are attached; means which 
make it possible to determine the instant at which the. 

20 person concerned takes a step; an arithmetic unit with 
which the sensors and the above-mentioned means are 
connected, which arithmetic unit comprises an algorithm 
which makes it possible, on the basis of a number of 
body dimensions of the person concerned and on the basis 

25 of the signals coming from the above-mentioned sensors, 
to determine at least the step distance for every 
step as well as the cumulated step distance as of a 
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certain, starting point. 

On the basis of a limited number of body data of the 
person on foot concerned, such as the length of the legs 
and the distance between the hip joints, it is possible 

■ 

5 to determine in a relatively simple manner, on the basis 

« 

of the measurement data of the orientation of the torso . 
and of the legs, at any time, the mutual position of the 
feet of the person by applying a geometric algorithm in 
the arithmetic unit. 

.10 Thus it becomes possible to determine for every step, in 
other words each time the person is situated with both 
feet on the ground, the distance of the step and, by 
cumulation of the successive distances of the steps, 
the total distance covered as of a certain starting 

15 point . 

Preferably, the geometric algorithm is such that also the 
step direction can be determined, as a result of which it 
also becomes possible to determine the route followed by 
the person as of the above-mentioned starting point. 

20 The inertia sensors are preferably applied on the body 
of the person by means of a tight fitting garment, for 
example in the shape of trousers or the like, onto which 
the sensors are attached, in such a manner that they 
cannot move, or practically cannot move in relation to the 

25 torso or the legs. 

Such sensors are advantageous in that they are relatively 
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small and, consequently, hardly hinder the user in his/her 
movements, and moreover in that the measuring results are 
far less sensitive to fluctuations in the magnetic field, 
which has for a result that the obtained results are much 
5 more precise and reliable than with the known systems. 

The device is preferably equipped with a portable 
electric power, supply for the sensors and for the 
arithmetic unit, as a result of which the device can be 
used in an autonomous manner without any additional 
10 peripheral equipment . 

I ■ ■ • ■ 

In order to better explain the characteristics of the 
pj^esent invention, the following preferred embodiments 
of a device according to the . invention are given as an 
example only without being limitative in any way, with 
15 reference to the accompanying drawings, in which: 

figure 1 schematically represents a person on foot, 
equipped with a device according to the invention; 
figure 2 is a block diagram of a sensor which is 
20 indicated by arrow F2 in figure 1; 

figure 3 indicates the road followed by the person on 

■ 

foot ; 

figure 4 represents a block diagram of a Kalman 
filter, as applied in the device of figure 1; 

* 

25 figure 5 represents a variant of figure 1 . 

Figure 1 represents a person 1 who is equipped with a 
device 2 according to the invention. 
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. In the given example, the device 1 consists of a garment 
3 in the form of trousers or the like fitting tightly to 
the body of the person 1 and onto which are provided 
five small light-weight sensors 4, more particularly 
5 what are called inertia sensors, one sensor 4 of which is 
attached to the torso, for example by means of a belt 5, 
whereas the other sensors 4 are attached to the legs, 
more particularly to the upper legs and to the lower 
legs . 

10 The textile fabric out of which the garment 3 is made, is 
preferably characterised in that it is easily 
washable and lets perspiration through, is 
comfortable to wear and is in good contact with the 
body, such that the sensors 4 do not shift on the body 

15 while the person 1 moves, and moreover, thanks to the 
elasticity of the fabric, does not hinder the person's 
movements . 

Each of the above-mentioned sensors 4 is formed of a 
20 housing 6 in which, as represented in figure 2, a number 
of raicrosensor elements have been provided, namely three 
gyroscopes 7 which measure the absolute angular 
velocity according to three mutual directions which 
are preferably at right angles; two or in this case 
25 three magnetometers 8 measuring the terrestrial magnetism 
and together forming an electronic compass to measure the 
azimuth of the sensor 4, more particularly the azimuth of 
a fixed coordinate system of the sensor 4 which serves as 
a reference; and finally two accelerometers 9 which measure 
the acceleration of the sensor 4 according to the above- 
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mentioned three perpendicular directions and which 
together form an electronic spirit level to measure the 
inclination and the rolling position of the sensor 4, more 
particularly the inclination and rolling position of the 
5 above-mentioned fixed coordinate system of the sensor 4 
which serves as a reference - 

* 

Other possible embodiments of sensors 4 are not excluded. 
Thus, for example, also double-axled magnetometers and two 
double-axled accelerometers may be used. What is 

10 important is that the magnetometers and accelerometers 
allow for measurements in three directions which are not" 
situated in the same plane, for example according to 
three orthogonal directions, for example a vertical 

I 

direction and two perpendicular horizontal directions. 

15 The output signals of the above-mentioned microsensor 
elements 7-8-9 are connected, possibly after having been 
amplified by an amplifier 10 and after having been 
converted by an analog- to- digital converter 11, to a 
microprocessor 12 which in this case forms a data buffer 

20 for the measurement data of the sensor 4 and whose output 
signal, as will be further explained, is a measurement 
for the absolute orientation of the body part onto 
which the sensor 4 concerned is attached, namely the 
torso and the upper and lower legs. The absolute 

25 orientation is determined for example by the azimuth, 
the inclination and the rolling position of the sensor 4. 

■ 

The above-mentioned output signal is connected, either or 
not via a plug connection 13, by means of a cable 14, to 
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an arithmetic unit 15 which is carried by the person 1, for 
example on the belt 5. 

The arithmetic unit 15 and the sensors 4 are fed by a 
5 battery 16 or any other form of power supply whatsoever, 
such as solar cells or the like, which is preferably 
portable . 

i 

The arithmetic unit is provided with a first algorithm 
which makes it possible, on the basis of the signals of 

10 the sensors 4 on the one hand, and the body dimensions of 
the person concerned' on the other hand, more particularly'* 
the length of the upper and lower legs and the distance 
between the hip joints, to calculate the position of the 
feet of the person at any time, by means of a geometric 

15 vector calculation which is understood by any 
professional and which, consequently, will not be 
treated any further in detail here. 

Further, the arithmetic unit comprises a second 
algorithm which makes it possible, on the basis of the 

20 signals of the accelerations of the accelerometers 9 of 
the sensors 4 , to determine when the person 1 makes 
contact to the ground with his feet, on the basis of 
which the .instant can be derived at which the person has 
made a step when he touches the ground with both feet. 

25 Also this second algorithm is understood by any 
professional . 

The working of the device 2 according to the invention is 
as follows. 
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When the person 1 is walking, the arithmetic unit 
successively receives the data of the sensors 4 at a 
certain frequency. 

On the basis of these data, by means of the second 
algorithm, the instant at which the person 1, after he 
has taken a step, sets his foot on the ' ground, is 
determined . 

At that moment the second algorithm determines the 
position of the feet of the person 1, from which the 
distance of the step L, as well as the step direction of 
the person -1 can be determined. 

As represented in figure 3, it is possible to calculate 
the total distance of the step (LiH-L2+L3+ . • . ) as of a 
certain starting point A, as well as the following 
route ABCDE, by successively calculating the distance of 
the step L and the direction of each step, in a simple 
manner by cumulating the results of the calculations. 

■ * 

This allows the person concerned to know his/her 
position at any time, as well as the distance which 
he/she has already covered. 

The results of the calculation can for example be 
visualised on a screen of the arithmetic unit. 

The arithmetic unit uses the dimensions of the legs of 
the person 1 and the distance between the hip joints. 
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These dimensions can be measured on the person 1 
concerned and they can subsequently be put in in the 
arithmetic unit via a keyboard or the like. 

Another possibility to put in these data, is by 
calibrating the device. 

In order to determine the length of the upper legs and 
the distance of the hip .joints, the person 1 concerned 
will sit for example with his knees on the ground, with 
his knees at a certain distance from each other, after 
* which, after* the signals of the sensors 4 for this 
position have been read, the desired dimensions, can be 
calculated by means of a reverse calculation of the first 
algorithm. 

The length of the lower legs can then be determined, for 
example, by making a step with a known distance of the 
step L and by subsequently, on the basis of the 
measurements of * the sensors 4, making a reverse 
calculation with the first algorithm. 

Thus, such a calibration is very simple and requires no 
special additional equipment, as is often the case with 
the known devices . 

As will appear from what precedes, each sensor 4 provides 
a signal of the absolute orientation of the sensor 4 
concerned, characterised by an azimuth, an inclination 
and a rolling position in the following manner. 
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Gyroscopes 7 are generally very suitable for measuring, 
orientation changes, also during (relatively) fast 
movements. The output signals of the gyroscopes 7 are, as 
is known, in proportion to the angular speed at which 
5 they move. By integrating this output signal 
arithmetically in time, an absolute angular orientation 
position of the gyroscope 7 is obtained, and thus also 
of the sensor 4 in which the latter is integrated. 

From practice we know that, by integrating the output 
10 signal of a gyroscope, an increasing deviation is always 
created, commonly known as the drift of a gyroscope 7, 

In order to eliminate the above-mentioned drift, the 
microprocessor 12 or the arithmetic unit 15 compares the 
absolute orientation, which is obtained on the basis of . 
15 the signals of the gyroscopes 7, to the absolute 
orientation which is determined by the signals of the 
above-mentioned magnetometers 8 and the accelerometers 
9 and the necessary correction is made on the basis 
of this comparison. 

20 The above-mentioned drift of each sensor 4 is corrected by 
means of software by applying a filter of what is called 
the Kalman type . 

The working of such a Kalman filter is illustrated by 
means of the block diagram of figure 4. 

25 The signals coming from the gyroscopes 7 are evaluated by 
a certain software algorithm 17 known as such, and they 
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are converted into a best estimated value 18 of the 
absolute orientation of the sens9r 4, characterised by an 
azimuth, an inclination and a rolling position- Said best 
estimated value 18 is then compared to the value 19 of 
5 the absolute orientation of the sensor 4, characterised 
by the azimuth, inclination and rolling position, 
measured by the magnetometers 8 and the accelerometers 7, 
which leads to a correction signal 2 0 in order to correct 
the drift. 

10 This correction signal 2 0 is then subtracted from the 
signal 21 measured by the gyroscopes 7, such that, after a 
signal 22 has been corrected, after the integration by 
integration software 23, a correct value 24 of the 
absolute orientation of the sensor 4 concerned is 

15 obtained, which is then further used by the first 
algorithm in order to calculate the above-mentioned 
distance of the steps and step directions. 

Figure 5 represents a variant of a device according to 
the invention as described above, whereby the device is 
20 expanded in this case with the following elements: 

• a positioning system 25 which is coupled to the above- 
mentioned arithmetic unit 15, for example in the form of 
a GPS -system ; 

• means 26 for realising a wireless connection with an 
25 external communication network; 

• a connection 27 to make a connection with .an 
external computer or PC 28. 
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By combining the signals of the positioning system 25 and 
of the calculation results of the arithmetic unit 15, one 
obtains a very competitive system to determine the 
position* of the person 1, whereby these 
5 calculation results so to say complete the data coming 
from the positioning system, as a result of which the 
position of the person 1. can be determined with great 
accuracy and reliability. 

Thank to the wireless connection, the position of the 
10 person 1 can be transferred in a wireless manner via a 
communication network "to an external receiver, such that 
the movements of the person can be followed from a 
distance. 

Thanks to the connection 27, the data of the 
15 arithmetic unit 15 can be read via an external computer 
28. For a further evaluation or processing of these 
data, the algorithms- can be loaded and updated, and the 
data of the users can be put in. 

Although in the above-mentioned example, the device 2 is 
20 equipped with five sensors 4, it is not excluded to use 
only three sensors 4, namely one on the torso and one on 
each leg, more particularly one on each upper leg or ' one 
on each lower leg. 

The second algorithm which makes it possible to determine 
25 the instant at which the person 1 takes a step, can also 
be replaced by other means which make it possible to 
determine when the person, after having made a step, 
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sets his foot on the ground, for example by pressure 
sensors which are built in in the soles of the person 1 
and which are connected to the arithmetic unit 15 • 

•• It is clear that the above-mentioned device can also be 
used on animals, on robots or the like, for example in 
order to be able to follow their movements. 

The present invention is by no means limited to the 
embodiments given as an example and represented in the 
accompanying drawings; on the contrary, such a device 
according to the invention can be made in all shapes 
and dimensions while still remaining within the scope of 
the invention. 



